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ABSTRACT 
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by 
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ABSTRACT 



A procedure for the control system design for a small 
unmanned, untethered, underwater vehicle was specified. The 
early phases of this design procedure were performed for the 
vehicle. The linear equations of motion for small 
perturbations about an equilibrium condition were developed, 
and the values of the hydrodynamic coefficients were 
determined. After the transfer functions were developed to 
relate the vehicle motion in each of the six degrees of 
freedom to small deflections of the rudder or stern planes, 
computer programs were written to determine the poles and 
zeros of the transfer functions. The vehicle s response in 
the time domain to one degree deflections of the rudder and 
stern planes was determined and plotted. The vehicle’s 
response indicated that the vehicle was stable and that the 
size of the control surfaces could be reduced to minimize 
drag while maintaining vehicle stability. The nonlinear 
equations representing the vehicle’s motion in six degrees 
of freedom were incorporated into a computer model of the 
vehicle. The outputs of this model ( linear and angular 
velocities in six degrees of freedom ) are the state 
variables which will be needed during later phases of the 
control system design. modern control theory. 
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Chapter I 
INTRODUCTION 

The potential uses for a small unmanned, untethered 
submersible vehicle ( SUUV) are numerous. One of the key 
systems in the design of such a vehicle is the control 
system, which must be able to control the vehicle* 

1. during transit to and from the vehicle’s operating 
location and depth; 

2. while the SUUV performs its mission on location; and 

3. during some emergencies for which pre-programmed 
corrective action has been specified. 

In order to perform these functions, the SUUV 1 s control 
system must be able to accept pre-programmed information 
concerning course, distance and operating depths as well as 
real time inputs from various onboard sensors. The output 
from the control system is used to control the rudder and 
horizontal control surfaces and ballast control system to 
cause the SUUV to carry out its programmed assignments. 

The length of the mission which the SUUV will be able to 
perform will be dependent on the amount of energy which can 
be installed and the rate at which the available energy is 
consumed. Therefore, the control system should be optimized 
such that the SUUV expends the smallest amount of energy 
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while it performs its mission. Designing the control system 
to minimise the overall vehicle consumption of energy 
requires that different solutions to the control system 
design problem be evaluated in terms of energy consumption. 
For example, the size of the vertical and horizontal control 
surfaces could be made large enough to provide straight line 
stability of the vehicle with no control surface deflection. 
Alternatively, the size of the control surfaces could be 
made smaller to reduce the drag and thereby reduce the 
energy required for propulsion. However, smaller control 

surfaces would require an active control system (an energy 
drain) to provide vehicle straight line stability. 

The design of the control system should follow a logical 
sequence. Although the demarcations between different 

phases of the design process are not distinct, the following 
phases are identified for this project. 

Phase I Identify the vehicle size, shape and mission 
requirements . 

Phase II Identify a mathematical model to represent 
the motion of the vehicle in six degrees 
of freedom. Linearize the mathematical 

model . 



Phase III Calculate the values of the hydrodynamic 
coefficients in the linearized equations. 
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Phase IV Form the transfer functions for each of the 
linearized equations. Check for vehicle 
stability by calculating the values of the 
poles and zeros for each transfer 
function. Determine the vehicle time 

response to a small control surface 
deflection . 



Phase *V Using modern control theory, model the 
vehicle in state space using the six 
nonlinear equations which describe its 
motion. Include in the model the effects 
of random envir onmental disturbances. 



Phase VI Model the outputs of the vehicle sensors 
which will be used to determine the 
control signal. Include the effects of 

random noise in the measurements. 



Phase VII Construct an observer (Kalman filter) to 
estimate values of the states which cannot 
7 be measured directly by the vehicle's 

sensors . 



Phase VIII Combine Phases V, VI, and VII into a 
complete model of the vehicle’s motion. 
Use this model to design a linear control 
system which will control the vehicle in 
the predicted manner. 
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In this thesis. Phases I through V are performed in detail, 
and a brief discussion of Phases VI, VII and VIII is 
provided . 

Phases I and II are discussed in Chapter Two. Figure 1.1 
shows the principal dimensions of the SUUV. Although the 
shape and dimensions were selected arbitrarily, it was felt 
that these parameters would be close to those which might be 
selected for an actual vehicle design. The control system 
design procedure used in this thesis should be appropriate 
for any vehicle with missions similar to those of the SUUV. 
Figure 1.2 is a block diagram representation of the 
anticipated inputs and outputs for the SUUV’s control 
system. The linearized equations which are developed in 
Chapter Two are adequate to predict the vehicle's response 
to small perturbations about the assumed equilibrium 
condition of straight ahead motion with the control surfaces 
undeflected . 

Phase III, calculation of the hydrodynamic coefficients, 
is performed in Chapter Three. 

In Chapter Four, the linearized, small perturbation 
equations of motion for the vehicle which were developed in 
Chapter Two are solved individually to find the transfer 
functions (Phase IV). These transfer functions relate u 
(forward velocity), w (vertical velocity), and 6 (pitch 
angle) to small deflections of the stern planes; and v 
(sideslip velocity), 0 (roll angle), 



v 



and 0 (yaw angle) to 
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FIGURE 1.1 



VEHICLE SHAPE AND DIMENSIONS 



( INPUTS ) 



( OUTPUTS ) 




FIGURE 



1.2 CONTROL SYSTEM INPUTS AND OUTPUTS 



The poles and zeros of 
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small deflections of the rudder, 
these transfer functions were calculated. Appendix C 

contains the computer programs used to calculate the poles 
and zeros of the transfer functions. The inverse LaPlace 
transforms of the transfer functions were evaluated at a 
series of times to determine the response of the vehicle to 
a small step change in rudder or stern plane position. 
These time response curves were evaluated to determine if 
the settling time and stability of each response mode were 
satisf ac tory . The computer programs used to calculate the 

time responses are listed in Appendix D. 

Having determined from the classical control theory that 
the initial estimate of the geometry of the vehicle was 
satisfactory from the aspect of stability and time response, 
in Chapter Five modern control theory was used to proceed 
with the beginning of an in-depth design of the control 
system (Phase V). Figure 1.3 shows a block diagram of the 
major elements of a modern control system. This thesis 

includes a development of the model used to represent the 
motion of the vehicle. This model is a set of nonlinear 
equations that describe the complete motion of the vehicle 
in six degrees of freedom - surge, sway, heave, roll, 
pitch, and yaw - and also includes terms to model the 
effects of random environmental disturbances on the vehicle. 
A computer program is described which will evaluate the 
states (velocities and angular velocities) at a given time. 
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Disturbances 




FIGURE 1.3 



BLOCK DIAGRAM OF MODERN CONTROL SYSTEM 



15 



This program is listed in 
this thesis should include 
calculate the information d 
and then using the program 
new programs to model the c 
sensors, observer, disturb 
allow simulation of the vehi 
vehicle response under 
evaluated. Based on these 
gains and observer gains c 
provide the required vehicle 
Chapter Six consists 
conclusions reached by the 



Appendix E. Follow-on work to 
developing computer programs to 
iscussed in phases VI and VII, 
in Appendix E along with these 
omplete system - input, plant, 
ances, and output. This would 
cle motion in real time and the 
various conditions could be 
responses, the optimal feedback 
an be adjusted if necessary to 
response . 

of a short summary and the 
author . 
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Chapter II 
EQUATIONS OF MOTION 

2 . 1 IDENTIFICATION OF THE VEHICLE AND ITS MISSION 

The small unmanned, untethered, underwater vehicle for 
which this control system design procedure was developed is 



depicted in Figure 1 


. 1 . The principal dimensions and 


characteristics of this 


vehicle are: 


Length overall 


11.67 feet 


Maximum diameter 


2 1 inches 


weight 


1162 pounds 


Buoyancy 


1162 pounds 


Control surfaces 


Rudder 

Stern Planes 


Symmetry 


Port-Starboard 

Deck-Keel 



The mission of the SUUV is = 

1. Transit to operating location and depth; 

2. Operate for a predetermined period performing the 
intended mission such as monitoring the environment 
or conducting inspections of underwater equipment; 
and 

3. Return to the predetermined location for recovery. 
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2 . 2 DEVELOPMENT OF THE EQUATIONS OF MOTION 

The SUUV was treated as a rigid body with deck-keel and 
port-starboard symmetry whose motion can be described using 
six degrees of freedom - surge, sway, heave, pitch, roll, 
and yaw. The control effectors on the SUUV include a 
rudder, horizontal control surfaces called stern planes, and 
a propeller at the stern. Mathematical equations which can 
be used* to model the movement of the SUUV in all six degrees 
of freedom were then developed following the procedure used 
by Humphreys 1 . Appendix A contains a list of the notations 
used in these equations and throughout this thesis. These 
notations follow the standard nomenclature introduced in the 
Society of Naval Architects and Marine Engineers TMB 1-5. 2 

The equations which describe the forces, F, and moments, 
M, acting on the SUUV are: 



F = 



on = 



d__ 

dt 

d 

dt 



(Momentum) 

(Angular momentum) 



( 1 ) 



( 2 ) 



1 Humphreys , D . E . ; Development of the Equations of Motion and 

Transfer Functions for Underwater Vehicles pp . 1-15 Naval 

Coastal Systems Laboratory; Panama City, Florida, July 
1 976. 

2 The Society of Naval Architects and Marine Engineers, TMB 
No. 1-5; Nomenclature for Treating the Motions of a 
Submerged Body Through a Fluid ; April, 1952. 
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A set of right-hand, orthogonal coordinate axes centered at 
the center of mass, CG, of the SUUV uas used to develop the 
equations of motion. Positive directions for the axes, 
linear velocity components, angular velocity components, 
angles, forces and moments are shown in Figure 2.1. 

The inertial forces and moments acting on the vehicle can 
be written as : 



ZX = mCU + 2U - RV) 



ZY = m ( V + RU - PW) 



ZZ = m(U +PV - 2U) 



ZK = PI - RI + 2R ( I - I ) - P2I 

X X2 2 y X 2 



ZM = 21 + P R ( I - I ) - R 2 I + P 2 I 

y X 2 X 2 X 2 



ZN = RI - PI + P2(I - I ) +2RI 

2 X 2 y X X 2 



(3) 



(4) 



(5) 



( 6 ) 



(7) 



(8) 



The total motion of the vehicle can be assumed to consist 
of two parts ♦* (1) an average motion representative of the 
equilibrium condition; and (2) a dynamic motion that 
consists of small perturbations about the average motion. 
Thus, the instantaneous velocity components at any time can 



be written*- 
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FIGURE 2.1P0SITIVE DIRECTIONS OF AXES, ANGLES, VELOCITIES, FORCES AND MOMENTS 
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U = U 0 + u C 9 ) 

V = Vo + v CIO) 

W = Wo + M (11) 

P = P 0 + p (12) 

2 = So + q (13) 

R = R 0 + r (14) 

The zero subscripts represent the average or equilibrium 
velocity components and the small letters represent the 
dynamic velocity components. By defining the equilibrium 
condition as straight ahead motion with control surfaces 



undeflected, all average velocity components except Uo are 
zero and the total velocity equations can be rewritten: 



U o + u 


(15) 


V 


(16) 


u 


(17) 


P 


(18) 


q 


(19) 


r 


(20) 
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Substituting these equations into the inertial force and 
moment equations yields * 



EX = m(u + qw -rv) 



EY = m(v + rUo + ru - pu) 



EZ = m(w + pv -qU 0 -qu) 



EK = pi - rl + qrCI - I ) - pql 

X X2 2 y X2 



( 21 ) 



( 22 ) 



(23) 



(24) 



(25) 



EM = ql + pr ( I - I ) - r 2 I + p 2 I 



x 2 



X 2 X 2 



( 26 ) 



EN = rl - pi + pq ( I - I ) + qrl 

2 X 2 y X X 2 



The following assumptions will allow further simplification 
of these equations. 

1 . Assume the disturbances from the equilibrium 
condition are small enough that the products and 
squares of the changes in velocity are small compared 
to the changes themselves. 

2. Assume the disturbance angles are small enough that 
the sines of these angles may be set equal to 2 ero 
and the cosines set equal to one. 
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3. Products of the disturbance angles are approximately 
zero. 

The following equations result from these assumptions • 



ZX = mu 



( 27 ) 



ZY 



zz 



ZK 



ZM 



ZN 



m ( v + r U o ) 



m ( u - qU o ) 



pi - rl 

X xz 



qi 

y 



r I - pi 
2 xz 



( 28 ) 



(29) 



(30 ) 



(31 ) 



( 32 ) 



Additionally , using the 
equations (15-20), the 
velocities and the rate 
written : 



small perturbation assumption and 
relationship between the angular 
of change of the angles can be 



• ( 33) 

P = <t> 

• (34) 
q = $ 

• ( 35) 
r = ^ 
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In addition to the inertial forces and moments, the vehicle 
also experiences hydrodynamic forces and moments due to the 



moments are functions of the relative velocity, acceleration 



These forces and moments can be expressed in terms of the 
Taylor series expansion about the equilibrium condition. 
Two assumptions allow considerable simplification of these 
expansions . 

1 . Assume second order and higher terms may be neglected 
because only small perturbations from the equilibrium 
postion are allowed. 

2. Assume that since the XZ plane is a plane of 
symmetry, X , 2 , and M are functions only of 

u,u,q, their derivatives, and 6 ; and Y , N , and K 
are functions only of v, p, r, their derivatives and 
0 . 

Therefore, the hydrodynamic forces and moments expanded in a 
Taylor series and simplified by the above assumptions can be 
written : 



forces exerted by the surrounding fluid. These forces and 



and position as well as control surface deflections. They 



can be expressed in functional form as : 



( 36 ) 



F = f(u,v,w,u,v,w,p,q,r,p,q,r,0, 0,^,5) 




+ Y r + Y-r + Y x <5* 



(37) 

(38) 

(39) 



r r 



+ K-r + K r + L6 
r r 6 



N. “ N + N*v + N v + N*p + N p + N <j> + N*r + N r + N.5 
hov v p r p r <f> r r 6 
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X - X + X*u + X u + X*w + X w + X *q + X q + X Q 0 + X x 6 (401 
nouuwwq n q n 9 6 ^ w ' 

Z. - Z + Z-u + Z u + Z-w + Z w + Z-q + Z q + Z Q 0 + Z*5 (41') 

houuwwq M q M 0 6 ^ ' 

M, - M + M*u + M u + M*w + M w + M*q + M q + M ft 9 + M r 5 (421 
nou u w w q q $ 6 ^ J 

Terms similar to X <u> 3 u expresses the change in the 
force or moment because of the disturbance velocity. X<u> 
is called a stability derivative or hydrodynamic coefficient 
and is defined as the change in the X force with respect to 
the u velocity and evaluated at the equilibrium condition. 

( ax ) 

X = 

u ( au ) o 

The gravity and buoyancy forces and moments can be 
expanded in a similar fashion and the complete linearised, 
small perturbation equations of motion for the SUUV are- 

mi * X*G + X u u + x^w + X w w + x-q + X q q + X Q 0 + X^« s ( 43 ) 

m(w - U q 0 ) = Z*u + Z u u + Z^w + Zjt + Z*q + Z^q + Z Q 0 + ( 44 ) 

10= M»u + M u + M*w + M w + M-q + M a + M 0 + M. 6 f 4 5 

yuuwwqqv ^ v J 

and 



3 The notation < > indicates a subscript. 
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m(v + U i) = Y* v + Y v +. Y*p + Y p + Y <p + Y*r + Y r + Y. 6 (46) 

o v v p p 9 r r 0 r ^ 

I <f> — I T = K*v + K v + K*p + K p + K <J> + K*r + K r + K. 6 ( 47 ) 

x Y xz v v p p 4> r r ° R R 

I 'i - I "<b = N*v + N v + N*p + N p + N 4> + N*r + N r + N <5 (48) 

z xz v v p p <p r r °R rv 

These two groups of three equations (43-45) and (46-48) 
are functions of different variables. Hence, the motion of 
the vehicle can be examined in the vertical (XZ) or 
horizontal (XY) plane independently of motion in the other 
plane. (The motion of the vehicle in the two planes is said 
to be uncoupled.) The first set of equations is usually 
called the vertical or longitudinal set of equations and the 
second set is often called the horizontal or lateral set of 



equations . 
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Chapter III 

CALCULATION OF THE HYDRODYNAMIC COEFFICIENTS 
3 . 1 CONTRIBUTIONS FROM THE BODY 

The values for the hydrodynamic coefficients uere calculated 
by first approximating the body shape as an ellipsoid and 
calculating values for this shape, and then calculating and 
adding the contributions from the fins and the nozzle. The 
ellipsoid representing the body is depicted in Figure 3.1. 



Volume of Ellipsoid 
V = 4/3 7r a b 2 



V = 


18.04 ft. 3 


Buoyancy 


Force of Ellipsoid 
B = p V 




B = 1162 lbf . 



Surface Area of Ellipsoid 



ab 

S = 27rb 2 + 2 r sin’ 1 ^ 

€ 
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a = 5.625' 
b = 0.875' 



€ = eccentricity 
€ = c/a 

c = (a 2 - b 2 F 

€ = 0.988 



FIGURE 



3.1 ELLIPSOID USED TO REPRESENT VEHICLE 
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<= = c/a where € = eccentricity 4 
€ = .988 



S = 49.3 ft. 2 I 

I 



Landweber and Johnson 5 determined empirical formulas to 
determine the values of many of the hydrodynamic 
coefficients. These formulas contain the terms K',K1,and K2 
which are determined for this vehicle by using the table 
provided by Lamb 6 . Entering this table with the value a/b = 
5.714, the values of K T , K 1 , and K2 are: 

K T = 0 .782 
K 1 = 0.041 
K 2 = 0.925 

Moments of Inertia 

I = I for a prolate spheroid 
y 2 



I 

I 

I 



4 Thomas, G.B. Jr.; Calculus and Analytic Geometry ; p. 478; 
Addison-Wesley Publishing Co.; Reading, Ma.; 1960. 

5 Landweber, L. and J ohns on , J . L . ; Prediction of Dynamic 
Stability Derivatives of an Elongated Body of Revolution ; 
NSRDC Report C-359; May, 1951. 

6 Lamb, Sir Horace; Hydrodynamics , 6th Ed.; pp . 155; Dover 

Publications , Hew York, 1945. 



